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Die folgondon Angaben sind den vom Anmelder eingereichten Unterlagen e nt no m men 

Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters 

© Die vorliegnde Erfindung schafft ein Verfahren zum Er- 
fassen und Kompensieren von kinematischen Verande- 
rungen eines Roboters (10) aufgrund interner und/oder 
externer Einflusse mit den Schritten: Bereitstellen eines 
Robotermodells in Form eines technischen Algorithmus 
mit einem oder mehreren festgelegten Paramtern, wel- 
che dietheoretische raumliche Stellung des Roboters (10) 
in Abhangigkeit von einer oder mehreren Steuergrdfcen 
beschreibt; Steuern der theoretischen raumtichen Soll- 
stellung des Roboters mit einer Robotersteuerung (100) 
gemaR dem Robotermodell; Erfassen der tatsachlichen 
raumlichen Iststellung des Roboters (10) im Betrieb durch 
eine Sensoreinrichtung (K 1# K 2 ; 50); Erfassen der kinema- 
tischen Veranderungen anhand der Abweichung der er- 
faBten tatsachlichen raumlichen Iststellung des Roboters 
■ (10) von der theoretischen raumlichen Sollstellung des 
t Roboters (10); Anpassen des oder der Parameter des Ro- 
• botermodells zum Kompensieren der kinematischen Ver- 
anderungen unter Berucksichtigung der erfafcten Abwei- 
chung; und Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit der Robotersteuerung (100) ge- 
mafc dem Robotermodell mit dem oder den angepafcten 
Parametern. 
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Beschreibung 

Die vorliegende ErfindunTbcunffl cin Vcrfahren zuin Erfasscn und Kompensiercn von kinenmuschcn Veranderungcn 
lUr bbw:W LftuSe Robot anwendbar, werden die vodiegende Ernndung sowie die ibr zugrundeUegende Proble- 

schaffen, welches solche ungewunschten Einfliisse erfassen und kompensieren kanm 
55 ^tnt^pShtntden sich vorteilhafte Weicerbildungen und Verbesserungen des in Anspruch 1 angegebenen 
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welche extern aufgestellt iS 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mm^RTens ein Lageerfassungssen- 
sor verwendet wird, welcher an der Robotcrhand angebracht ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird das Erfassen der kinematischen Veranderungen anhand der 
Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters von der theoretischen raumlichen Sollstel- 5 
lung des Roboters an den Referenzpunkten durchgefuhrt, indeni ein jeweiliger Korrekturvektoren zwischen der erfaBten 
tatsachlichen raumlichen Iststellung des Roboters und dem entsprcchcndcn Referenzpunkt eingefuhrl wird. 

GemaB einer weiteren bevorzugten Weiterbildung wird die tatsachlichen raumliche Iststellung des Roboters im Be- 
trieb durch die Sensoreinrichtung mittels eines am Roboter angebrachten MaBkorpers ermittelt wird. Durch die MaBkor- 
pcrvcrmessung werden die Basis und das Tool unabhangig von der eigcnen Kinematik des Roboters geschatzt, und somit to 
gehen auch seine Fehler nicht in die Schatzung ein. 

GemaB einer weiteren bevorzugten Weiterbildung wird die Gute der im Betrieb durch die Sensoreinrichtung erfaBten 
tatsachlichen raumlichen Iststellung des Roboters ermittelt wird und das Anpassen davon abhangig gemacht wird. Somit 
gehen als Import fur die Parameteranpassung nur giiltige bzw. zuverlassig ermittelte Daten ein, und AusreiBer sind eli- 
minierbar. 15 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Ermitteln der Gute durch Bereitstellen eines MaBkorpers 
mit Markern am Roboter; Festlegen eines inneren Koordinatensystems auf dem MaBkorper und der entsprechenden Ko- 
ordinaten der Marker; Erfassen der Koordinaten der Marker im Weltkoordinatensystem durch die Sensoreinrichtung; op- 
timiertes Abbilden der Koordinaten der Marker im inneren Koordinatensystems auf die Koordinaten der Marker im 
Weltkoordinatensystem und durch Ermitteln der Gute anhand des mittleren Fehlers der Abbildung. Diese \forgehens- 20 
weise liefert eine qualitative Aussage iiber die Gute der MeBdaten. 

Ausfuhrungsbeispiele der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden Beschreibung na- 
her erlautert. 

Es zeigen: 

Fig. 1 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform des 25 
erfindungsgemaBen Verfahrens; 

Fig. 2 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens; und 

Fig. 3 eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten Aus- 
fuhrungsform des erfindungsgemaBen Verfahrens. 30 

In den Figuren bezeichnen gleiche Bezugszeichen gleiche oder funktionsgleiche Komponenten. 

Fig. 1 zeigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens. 

In Fig. 1 bezeichnet Bezugszeichen 10 einen an seinem Einsatzort fest montierten Roboter, 15 einen Roboterarm, 18 
eine (verdeckte) Roboterhand, 20 einen MaBkorper, R Referenzpunkte auf dem MaBkorper 20, 50 einen Lageermitt- 35 
Iungssensor, welcher mit dem MeBpunkt 55 zusammenwirkt, Ki und K 2 eine erste bzw. zweite externe Kamera, welche 
den MaBkorper in ihrem gemeinsamen Sichtbereich haben, 100 eine Robotersteuerung und 120 einen Hostrechner. Die 
Roboterhand 18 ist zusatzlich mit einem (nicht gezeigte) Werkzeug, z. B. einem MeBvideosensor, bestuckt. Mit diesem 
Systemaufbau ist man prinzipiell in der Lage, einerseits mit dem Roboter 10 Messungen vorzunehmen und andererseits 
die Position und Orientierung des MaBkorpers 20 zu bestimmen. 40 

In Form eine Steuerprogramms existiert in der Robotersteuerung ein Robotermodell in Form eines technischen bzw. 
physikalisch/mathematischen Algorithmus mit einem oder mehreren festgelegten Parametern, welches die theoretische 
raumliche Stellung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt. Als Parameter 
kommen beispielsweise Linklangen, Achsenschiefstande, Nullpunktfehler, Gelenklose, Gelenkelastizitaten usw. in 
Frage. 45 

Mittels dieses Modells und einer entsprechend modifizierten Kinematik ist der Roboter 10 in der Lage, kartesische Po- 
sitionen in seinem Arbeitsraum mit hoher Genauigkeit zu erreichen. 

Im folgenden wird naher erlautert, wie der oder die Parameter fur das Robotermodell festgelegt werden. Zum Zeit- 
punkt der Inbetriebnahme befindet sich der Roboter 10 in einer bestimmten kinematischen Konfiguration, die von den 
besagten internen und externen EinfluBf aktoren abhangig ist. Diese Referenzkonfiguration wird uber eine Referenzmes- 50 
sung festgehalten, indem der MaBkorper 20 an ausreichend vielen raumlichen Roboterstellungen (entsprechend Refe- 
renzpunkten aj mit i = 1 . . . n), welche durch die SteuergroBen bestimmt werden, durch die eine erste und zweite externe 
Kamera Ki bzw. K2 vennessen wird. Darauf erfolgt das Festlegen des oder der Parameter derart, daB das Robotermodell 
die raumliche Stellung des Roboters 10 an den Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit ei- 
ner bestimmten sehr hohen Genauigkeit beschreibt. Hoch bedeutet dabei, daB die Genauigkeit groBer ist als die aufgrund 55 
der kinematischen Veranderungen auftretenden Schwankungen. 

Andert sich nun die Referenzkonfiguration, d. h. treten kinematische Veranderungen des Systems auf, werden die Re- 
ferenzpunkte ai nicht mehr mit der sehr hohen Genauigkeit anfahrbar sein, welche durch die Referenzmes sungsparame- 
ter bestimmt ist, sondern es werden sich Abweichungen zwischen Soil- und Istwerten ergeben, welche mittels der beiden 
Kameras K t , K 2 und/oder dem Lagesensor 50 erfaBt werden. 60 

Aufgrund der jeweiligen Abweichung zwischen Sollwert Fj, und Istwert F*j wird eine Anpassung des oder der Para- 
meter des Robotermodeils ausgelost, namlich bei dieser Ausfuhrungsform, wenn die erfaBte Abweichung einen vorbe- 
stimmten Wert iiberschreitet. 

Diese Anpassung gcschieht dadurch, daB ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen 
raumlichen Iststellung F*i des Roboters 10 und dem entsprechenden Referenzpunkt als Sollwert F t eingefuhrl wird. Es 65 
gilt dabei die funktionelle Beziehung: 

T(M, ai ) • Tj = Fj (1) 
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W obe, «o, k « k A„ Fe h .erT(M, ^» F, zwiscben den, theo-ischen Sofc, a,) 
messung F, beschreiben, wWm das "^prungliche ^P^^ 8 ^^^ M mil don odcr den urspriingli- 

Diese Aufgabe fuhrt auf ein nicht-lineares Minimierungsproblem der Form. 

n 

I |T(M*.ai) - F i *-T' 1 l 2 = min. (2) 
i=l 

Die L.sung dieses Minimierungsproblerns erfolg, »«ta-aj-^-^ welche 
Durch die Einfuhrung der Korrekturvektoren gehngt es ako^ die Fehler ^^f»« EinfluBfakforen, sondern de- 

gefuhrt wird. « rtl i. te llune des Roboters mit der Robotersteuerung (100) gemaB dem Ro- 

mmBeh,™,!* one Anpraung d« od,r * f M ^»P™^ h """?° m Allbrtn « n von MeBme*n,ale» («*. Mate). 

allein die geometrische Invarianz, also Stabilitat gegenuber Verformungen. h aus einer Messung 

Das interne Koordinatensystem bzw. ^^KSSSStolgt un.er optimalen 

der MeBmerkmale, die darauf ir .ausreichend groBen Atatodffl^^^J*^^^ Uw 
Bedingungen und liefert alle Markerposmonen im mternen ^natensyste « w brachl ist , bezUgUc h des 

Eine Schatzung Uefert die Position und Onentierung des MaBkorpers, der am *°™ er * * MeBwerte y t Widen 
Wellkoordinatens g ystem S) wiez.B.erfaBt .lurch ^^^^^^Te^^^^^- 
mit den entsprechenden bekannten Koordrnaten x-, des S und etaemRotationsanteil (a, p\ 

^£5^^^ ^ ** - - MM ^ 

kleinsten Fehlerquadrate losen, namlich gemaB der Beziehung: 

n 

£ |A{a.b,c;a,p,y)Xi - Yi| 2 = min. (3) 

form des erfindungsgemaBen Verfahrens. ftilirte „ n^na^eichen KC eine Kamerasteuerungs/-auswertung- 
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fii^HpgemaBen Verfahrens. 

$ erkennbar, zeigen die unkompensierten Daten eine Abweichun^^or 



Ausfuhrungsform des erfiri 

Wie deutlich aus Fig. 3 erkennbar, zeigen die unkompensierten Daten eine AbweichuM^on bis zu etwa 0,390 mm ge- 
geniibcr der erstcn Messung vor den thermischen StreBfahrten. Demgegeniibcr zeigen die kompensiertcn Daten lediglieh 
eine Abweichung von bis zu etwa 0,125 mm gegeniiber der ersten Messung vor den thermischen StreBfahrten. Die Kom- 
pensation schafft also eine Verbesserung urn einen Faktor 3. 5 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzugter Ausfuhrungsbeispiele beschrieben wurde, ist sie 
darauf nichl beschrankt, sondern auf vielfaltige Art und Weise modifizicrbar. 

Insbesondere sind genannten Anwendungen nur beispielhaft und beliebig verallgemeinerbar. Auch ist die Positionser- 
fassung nicht auf Kameras beschrankt. Der MaBkorper muB nicht ein selbstandiger Korper sein, sondern kann in den Ro- 
boter integriert sein. Auch die genannten Algorithmen dienen nur IlLustrationszwecken und konnen durch andere geeig- to 
nete Optimierungsalgorithmen ersetzt werden. 

Bezugszeichenliste 

10 Roboter 15 
100 Robotersteuerung 
50 Sensor 

55 MeBpunkt fiir Sensor 50 
15 Roboter arm 

18 Roboterhand 20 
20 MaBkorper 
Ki Kamera 1 
K 2 Kamera 2 

KC KamerasteuerungsZ-auswertungeinrichtung 

150 MeBvideosensor 25 

200 MeBobjekt, Fahrzeugkarosserie 

PA MeBvideosensorsteuerungs/-auswertungeinrichtung 

R Referenzpunkt auf 20 

120 Hostrechner 
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1. Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters (10) aufgrund in- 
terner und/oder externer Einfliisse mit den Schritten: 

Bereitstellen eines Robotermodells in Form eines technischen Algorithmus mit einem oder mehreren festgelegten 35 
Parametern, welches die theoretische raumliche Stellung des Roboters (10) in Abhangigkeit von einer oder mehre- 
ren SteuergroBen beschreibt; 

Steuem der theoretischen raumlichen Sollstellung des Roboters mit einer Robotersteuerung (100) gemaB dem Ro- 
botermodell; 

Erfassen der tatsachlichen raumlichen Iststellung des Roboters (10) irn Betrieb durch eine Sensoreinrichtung (K lt 40 
K 2 ; 50) 

Erfassen der kinematischen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststel- 
lung des Roboters (10) von der theoretischen raumlichen Sollstellung des Roboters (10); 

Anpassen des oder der Parameter des Robotermodells zum Kompensieren der kinematischen Veranderungen unter 
Beriicksichtigung der erfaBten Abweichung; und 45 
Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Robo- 
termodell mit dem oder den angepaBten Parametern. 

2. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, daB das Anpassen des oder der Parameter des Robotermo- 
dells zur Kompensation der kinematischen Veranderungen unter Beriicksichtigung der erfaBten Abweichung er- 
folgt, wenn die erfaBte Abweichung einen vorbestimmten Wert iiberschreitet. 50 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB das Bereitstellen eines Robotermodells in Form 
eines technischen Algorithmus mit einem oder mehreren festgelegten Parametern folgendermaBen erfolgt: 
Anbringen eines MaBkorpers (20) an der Roboterhand (18); 

Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers (20) durch die Sensoreinrichtung (Ki, K 2 ; 50) an 
einer Vielzahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten; und 55 
Festlegen des oder der Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters (10) an den 
Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 
(Ki, K 2 ; 50) mindestens eine Kamera (Ki, K 2 ) verwendet wird, welche extern aufgestellt ist. 

5. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 60 
(Ki, K 2 ; 50) mindestens ein Lageerfassungssensor (50) verwendet wird, welcher an der Roboterhand (18) ange- 
bracht ist. 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB das Erfassen der kinemati- 
schen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) 
von der theoretischen raumlichen Sollstellung des Roboters (10) an den Referenzpunkten durchgefiihrt wird, indem 65 
ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) und 
dem entsprechenden Referenzpunkt eingefuhrt wird. 

7. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB die tatsachlichen raumliche 
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iststeliung des RoboA im **** dUrCh (K " K * *" "* ^ 

gebrachten MaBkorper^M) ermiUelt wild. H-Hurch eekcnnzeicb.net, daB die Giitc dcr im Belrieb 

5SSS!S2S532S^25£ "~ - * -—— — d " M " ter 

(R) im Weltkoordinatensystem; und 
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The method involves using a robot (10) model with one or more parameters describing the theoretical 
spatial position of the robot depending on one or more control parameters. The parameters control the 
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